import lejos.navigation.TachoNavigator;
import lejos.nxt.Button;
import lejos.nxt.Motor;

/**
 * 
 */

/**
 * @author Mathias
 *
 */
public class TNTest {

	/**
	 * @param args
	 */
	public static void main(String[] args) {
		
		TachoNavigator tn = new TachoNavigator(8.16f, 10.2f, Motor.C, Motor.B);
		
		Button.waitForPress();
		System.out.println("Starten");
		
		tn.setSpeed(30);
		
		//tn.travel(100); // units in cm
		tn.goTo(100, 0);
		tn.stop();
		tn.goTo(100, 100);
		tn.stop();
		tn.goTo(0, 100);
		tn.stop();
		tn.goTo(0, 0);
		tn.stop();
		
		System.out.println("Fertig");
		Button.waitForPress();
	}

}
